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Abstract — This paper provides new results for control of 
complex flight maneuvers for a quadrotor unmanned aerial 
vehicle. The flight maneuvers are defined by a concatenation of 
flight modes, each of vc hich is achieved by a nonUnear controller 
that solves an output tracking problem. A mathematical model 
of the quadrotor UAV rigid body dynamics, defined on the 
configuration space SE(3), is introduced as a basis for the 
analysis. We focus on three output tracking problems, namely 
(1) outputs given by the vehicle attitude, (2) outputs given by 
the three position variables for the vehicle center of mass, and 
(3) output given by the three velocity variables for the vehicle 
center of mass. A nonlinear tracking controller is developed on 
the special EucUdean group SE(3) for each flight mode, and the 
closed loop is shown to have desirable properties that are almost 
global in each case. Several numerical examples, including one 
example in which the quadrotor recovers from being initiaUy 
upside down and another example that includes switching 
and transitions between different flight modes, iUustrate the 
versatility and generality of the proposed approach. 

I. INTRODUCTION 

A quadrotor unmanned aerial vehicle (UAV) consists of 
two pairs of counter-rotating rotors and propellers, located 
at the vertices of a square frame. It is capable of vertical 
take-off and landing (VTOL), but it does not require complex 
mechanical linkages, such as swash plates or teeter hinges, 
that commonly appear in typical helicopters. Due to its sim- 
ple mechanical structure, it has been envisaged for various 
applications such as surveillance or mobile sensor networks 
as well as for educational purposes. 

Despite the substantial interest in quadrotor UAVs, little 
attention has been paid to constructing nonUnear control sys- 
tems that can achieve complex acrobatic maneuvers. Linear 
control systems such as proportional-derivative controllers 
or Unear quadratic regulators are widely used to enhance the 
stability properties of an equilibrium [1], [2], [3], [4], [5]. 
The quadrotor dynamics is modeled as a collection of sim- 
plified hybrid dynamic modes, where each mode represents 
a particular local operating region. But, it is required to do 
complex reachabiUty analyses to guarantees the safety and 
performance of such hybrid system [6]. 

A nonlinear controller is developed for the linearized 
dynamics of a quadrotor UAV in [7]. Backstepping and 
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sliding mode techniques are applied in [8]. Since all of these 
controllers are based on Euler angles, they exhibit singular- 
ities when representing complex rotational maneuvers of a 
quadrotor UAV, thereby significantly restricting their ability 
to achieve complex flight maneuvers. 

An attitude control system based on quaternions is ap- 
plied to a quadrotor UAV [9]. Quatemions do not have 
singularities, but they have ambiguities in representing an 
attitude, as the three-sphere, the unit-vectors in M^, double- 
covers the attitude configuration of the special orthogonal 
group, S0(3). Therefore, a single physical attitude of a rigid 
body may yields two different control inputs, which causes 
inconsistency in the resulting control system. A specific 
choice between two quaternions generates discontinuity that 
makes the resulting control system sensitive to noise and 
disturbances [10]. It is possible to construct continuous 
controUers, but they may exhibit unwinding behavior, where 
the controller unnecessarily rotates a rigid body through large 
angles, even if the initial attitude is close to the desired 
attitude, thereby breaking Lyapunov stability [11]. 

Geometric control, as utilized in this paper, is concerned 
with the development of control systems for dynamic sys- 
tems evolving on nonlinear manifolds that cannot be globally 
identified with Euclidean spaces [12], [13]. By characterizing 
geometric properties of nonlinear manifolds intrinsically, 
geometric control techniques provide unique insights into 
control theory that cannot be obtained from dynamic models 
represented using local coordinates. This approach has been 
applied to fully actuated rigid body dynamics on Lie groups 
to achieve almost global asymptotic stability [13], [14], [15], 
[16]. 

In this paper, we make use of geometric methods to define 
and analyze controllers that can achieve complex acrobatic 
maneuvers for a quadrotor UAV. The dynamics of the 
quadrotor UAV are expressed globally on the configuration 
manifold, which is the special Euclidean group SE(3). Based 
on a hybrid control architecture, we construct controllers that 
can achieve output tracking for outputs that correspond to 
each of several flight modes, namely an attitude controlled 
flight mode, a position controUed flight mode, and a velocity 
controlled flight mode. 

The proposed controller exhibits the following unique 
features: (i) It guarantees almost global tracking features of 
a quadrotor UAV as the region of attraction almost covers 
the attitude configuration space SO (3). Such global stability 
analysis on the special Euclidean group of a quadrotor UAV 
is unprecedented, (ii) Hybrid control structures between dif- 
ferent tracking mode is robust to switching conditions due to 



the almost global stability properties. Therefore, aggressive 
maneuvers of a quadrotor UAV can be achieved in a unified 
way, without need for complex reachability analyses, (iii) 
The proposed control system extends the existing geometric 
controls of the rigid body dynamics into an underactuated 
rigid body system, where its translation dynamics is cou- 
pled to the rotational dynamics in a unique way. (iv) It is 
coordinate-free. Therefore, it completely avoids singularities, 
complexities, discontinuities, or ambiguities that arise when 
using local coordinates or quaternions. 

The paper is organized as follows. We develop a globally 
defined model for the translational and rotational dynamics 
of a quadrotor UAV in Section The hybrid control archi- 
tecture and three flight modes are introduced in Section III 



Section IV presents results for the attitude controlled flight 
mode; Sections |V] and |VI] present results for the position 
controlled flight mode, and the velocity controlled flight 
mode, respectively. Several numerical results that demon- 
strate complex aerobatic maneuvers for a typical quadrotor 



UAV are presented in Section VII 



II. QUADROTOR DYNAMICS MODEL 

Consider a quadrotor UAV model illustrated in Figure 
[T| This is a system of four identical rotors and propellers 
located at the vertices of a square, which generate a thrust 
and torque normal to the plane of this square. We choose 
an inertial reference frame {61,(32,63} and a body-fixed 
frame {6i,62,fe3}- The origin of the body-fixed frame is 
located at the center of mass of this vehicle. The first 
and the second axes of the body-fixed frame, bi,b2, lie 
in the plane defined by the centers of the four rotors, 
as illustrated in Figure [l] The third body-fixed axis 63 
is normal to this plane. Each of the inertial reference 
frame and the body-fixed reference frame consist of 
a triad of orthogonal vectors defined according to the 
right hand rule. In the subsequent development, these 
references frames are taken as basis sets and we use vectors 
in to represent physical vectors and we use 3x3 
real matrices to represent linear transformations between 
the vector spaces defined by these two frames. Define 



J e I 



.3x3 



R e S0(3) 



de 



the total mass 
the inertia matrix with respect to the 
body-fixed frame 

the rotation matrix from the body-fixed 

frame to the inertial frame 

the angular velocity in the body-fixed 

frame 

the position vector of the center of mass 

in the inertial frame 

the velocity vector of the center of mass 
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the center of each rotor in the bi , &2 

plane 

the thrust generated by the i-th pro- 
peUer along the —63 axis 
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Fig. 1 . Quadrotor model 



Ti e M the torque generated by the i-th pro- 
peller about the 63 axis 
/ e M the total thrust magnitude, i.e., / = 

M £ M.^ the total moment vector in the body- 
fixed frame 

The configuration of this quadrotor UAV is defined by the 
location of the center of mass and the attitude with respect to 
the inertial frame. Therefore, the configuration manifold is 
the special Euclidean group SE(3), which is the semidirect 
product of M.^ and the special orthogonal group SO (3) = 

{R e M3X3 I jfTj^ ^ ^ ^ ^ 

The following conventions are assumed for the rotors and 
propellers, and the thrust and moment that they exert on the 
quadrotor UAV. We assume that the thrust of each propeller 
is directly controlled, and the direction of the thrust of each 
propeller is normal to the quadrotor plane. The first and 
third propellers are assumed to generate a thrust along the 
direction of —63 when rotating clockwise; the second and 
fourth propellers are assumed to generate a thrust along 
the same direction of —63 when rotating counterclockwise. 
Thus, the thrust magnitude is / = J2i=i fi^ 
positive when the total thrust vector acts along —63, and 
it is negative when the total thrust vector acts along 63. By 
the definition of the rotation matrix R e S0(3), the total 
thrust vector is given by —fRe^ £ in the inertial frame. 
We also assume that the torque generated by each propeller 
is directly proportional to its thrust. Since it is assumed 
that the first and the third propellers rotate clockwise and 
the second and the fourth propellers rotate counterclockwise 
to generate a positive thrust along the direction of —63, 
the torque generated by the i-th propeller about 63 can be 
written as = {—lycrffi for a fixed constant Crf. All 
of these assumptions are common [9], [3]. The presented 
control system can readily be extended to include linear rotor 
dynamics, as studied in [8]. 

Under these assumptions, the moment vector in the body- 
fixed frame is given by 
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The determinant of the above 4x4 matrix is Sc^fcP, so it 
is invertible when d and Crj ^ 0. Therefore, for given 
thrust magnitude / and given moment vector M, the thrust of 
each propeller /i, /2, /s, A can be obtained from ([T]i. Using 
this equation, the thrust magnitude / G M and the moment 
vector M E M.'^ are viewed as control inputs in this paper. 

The equations of motion of the quadrotor UAV can be 
written as 



X = V, 
mv — mge^ — fRe^, 

R = Rn, 



(2) 
(3) 
(4) 
(5) 



where the hat map ~ : ^ so (3) is defined by the 
condition that xy — x x y for x,y (see Appendix 

[a) . Throughout this paper, A„j(-) and \m{ ) denote the 
minimum eignevalue and the maximum eigenvalue of a 
matrix, respectively. 

III. GEOMETRIC TRACKING CONTROLS 

Since the quadrotor UAV has four inputs, it is possible to 
achieve asymptotic output tracking for at most four quadrotor 
UAV outputs. The quadrotor UAV has three translational 
and three rotational degrees of freedom; it is not possible 
to achieve asymptotic output tracking of both attitude and 
position of the quadrotor UAV. This motivates us to introduce 
several flight modes. Each flight mode is associated with a 
specified set of outputs for which exact tracking of those 
outputs define that flight mode. 

The three flight modes considered in this paper are: 

• Attitude controlled flight mode: the outputs are the 
attitude of the quadrotor UAV and the controller for 
this flight mode achieves asymptotic attitude tracking. 

• Position controlled flight mode: the outputs are the 
position vector of the center of mass of the quadrotor 
UAV and the controller for this flight mode achieves 
asymptotic position tracking. 

• Velocity controlled flight mode: the outputs are the 
velocity vector of the center of mass of the quadrotor 
UAV and the controller for this flight mode achieves 
asymptotic velocity tracking. 

A complex flight maneuver can be defined by specifying 
a concatenation of flight modes together with conditions 
for switching between them; for each flight mode one also 
specifies the desired or commanded outputs as functions of 
time. For example, one might define a complex acrobatic 
flight maneuver for the quadrotor UAV that consists of a 
hovering flight segment by specifying a constant position 
vector, a reorientation segment by specifying the time evolu- 
tion of the vehicle attitude, and a surveillance flight segment 
by specifying a time-varying position vector. The controller 
in such a case would switch between nonlinear controllers 
defined for each of the flight modes. 

These types of complex aerobatic maneuvers, involving 
large angle transitions between flight modes, have not been 
much studied in the literature. Such a hybrid flight control 



architecture has been proposed in [17], [18], [19], [6], but 
they are sensitive to switching conditions as the region of 
attraction for each flight mode is limited, and they required 
complicated reachability set analyses to guarantee safety 
and performance. The proposed control system is robust 
to switching conditions since each flight mode has almost 
global stability properties, and it is straightforward to design 
a complex maneuver of a quadrotor UAV. 

IV. ATTITUDE CONTROLLED FLIGHT MODE 

An arbitrary smooth attitude tracking command Rd{t) G 
SO (3) is given as a function of time. The correspond- 
ing angular velocity command is obtained by the attitude 
kinematics equation, ^ld = RjRd- We first define errors 
associated with the attitude dynamics of the quadrotor UAV. 
The attitude and angular velocity tracking error should be 
carefully chosen as they evolve on the tangent bundle of 
S0(3). First, define the real-valued error function on S0(3) x 
S0(3): 



^{R,Rd)^^tr[l-R^R] 



(6) 



This function is locally positive-definite about R = Rd 
within the region where the rotation angle between R and Rd 
is less than 180° [13]. For a given Rd, this set can be repre- 
sented by the sublevel set L2 = {R e S0(3) | i?,^) < 
2}, which almost covers S0(3). 

The variation of a rotation matrix can be expressed as 
SR — Rfj for 77 e M.^, so that the derivative of the error 
function is given by 

T>R-^{R,Rd) ■ Rfj = -^tr[i?Ji?77] ^cr-t] (7) 

where the attitude tracking error e is chosen as 



1 



= 7; i^d^ ^ R'^RdT 



(8) 



The vee map ^ : so (3) is the inverse of the hat map. 

We used a property of the hat map given by equation (50 1 
in Appendix A. 

The tangent vectors R e T7?SO(3) and Rd £ T/j^S0(3) 
cannot be directly compared since they lie in different 
tangent spaces. We transform Rd into a vector in TijS0(3), 
and we compare it with R as follows: 

R — Rd{R^R) = R{^ — R^ Rd^dRd ^) — R^n, 



where the tracking error for the angular velocity en G 
defined as follows: 



en 



n — R Rd^d- 



IS 



(9) 



We show that eo is the angular velocity vector of the relative 
rotation matrix RJR, represented in the body-fixed frame, 
since 



dt 



{RlR) = {RlR)en. 



(10) 



We now introduce a nonlinear controller for the attitude 
controlled flight mode, described by an expression for the 
moment vector: 



M = -kRER - knen + Q x Jil 



(11) 



where fc^, k^ are positive constants. 

In this attitude controlled mode, it is possible to ignore 
the translational motion of the quadrotor UAV; consequently 
the reduced model for the attitude dynamics are given by 
equations (j4]), (jSj), using the controller expression (111. We 
now state the result that (e^ , eo) = (0, 0) is an exponentially 
stable equilibrium of the reduced closed loop dynamics. 

Proposition 1: (Exponential Stability of Attitude Con- 
trolled Flight Mode) Consider the control moment M defined 
in ([TT]) for any positive constants ku.kn- Suppose that the 



initial conditions satisfy 



(12) 



len(0)ir < 



*(i?(0),i?<i(0)) <2, 
^ -fcfl,(2-^'(i?(0),i?d(0))). (13) 



Am(J) 

Then, the zero equilibrium of the closed loop tracking error 
(e_Rjeo) = (0,0) is exponentially stable. Furthermore, there 
exist constants a2 , /32 > such that 



^{R{t),Rd{t)) < mm{2,a2e-^''} 
Proof: See Appendix [B] 



(14) 



In this proposition, equations (12 1, (13 1 describe a region 
of attraction for the reduced closed loop dynamics. An 
estimate of the domain of attraction is obtained for which 
the quadrotor attitude Ues in the sublevel set L2 = {R G 
S0(3) I < 2} for a given R^. This requires 

that the initial attitude error should be less than 180°, in 
terms of the rotation angle about the eigenaxis between R 
and Rd- Therefore, in Proposition [T] exponential stability 
is guaranteed for almost all initial attitude errors. More 
explicitly, the attitudes that lie outside of the region of 
attraction are of the form exp{TTs)Rd for some s E S^. 
Since they comprise a two-dimensional manifold in the three- 
dimensional S0(3), we claim that the presented controller 
exhibits almost global properties in S0(3). It should be noted 
that topological obstructions prevent one from constructing a 
smooth controller on SO (3) that has an equilibrium solution 
that is global asymptotically stable [20]. The size of the 
region of attraction can be increased by choosing a larger 



controller gain fc/? in (13 1. 

Asymptotic tracking of the quadrotor attitude does not 
require specification of the thrust magnitude. As an auxil- 
iary problem, the thrust magnitude can be chosen in many 
different ways to achieve an additional translational motion 
objective. 

As an example of a specific selection approach, we assume 
that the objective is to asymptotically track a quadrotor alti- 
tude command. It is straightforward to obtain the following 
corollary of Proposition 1 . 

Proposition 2: (Exponential Stability of Attitude Con- 
trolled Flight Mode with Altitude Tracking) Consider the 



control moment vector M defined in (111 satisfying the as- 
sumptions of Proposition 1 . In addition, the thrust magnitude 
is given by 

n _ kx{x3 " X3J + k^{x3 - X3J + mg ~ 771x3^ 
63 • Re3 

where k^ , fc„ are positive constants, (t) is the quadrotor 
altitude command, and we assume that 



63 • Re3 + 0. 



(16) 



The conclusions of Proposition 1 hold and in addition the 
quadrotor altitude X3(t) asymptotically tracks the altitude 
command X3^(t). 

Proof: See Appendix [C] ■ 
Since the translational motion of the quadrotor UAV can 
only be partially controlled; this flight mode is most suitable 
for short time periods where an attitude maneuver is to 
be completed. The translational equations of motion of the 
quadrotor UAV, during an attitude flight mode, are given by 
equations (j2|l, |3k and whatever thrust magnitude controller, 
e.g., equation ( |15] l, is selected. 

V. POSITION CONTROLLED FLIGHT MODE 

We now introduce a nonlinear controller for the position 
controlled flight mode. We show that this controller achieves 
almost global asymptotic position tracking, that is the output 
position vector of the quadrotor UAV asymptotically tracks 
the commanded position. This flight mode requires analysis 
of the coupled translational and rotational equations of 
motion; hence, we make use of the notation and analysis 
in the prior section to describe the properties of the closed 
loop system in this flight mode. 

An arbitrary smooth position tracking command Xd[t) £ 
M.^ is chosen. The position tracking errors for the position 
and the velocity are given by: 



61, = W - Xd- 



(17) 
(18) 



The nonlinear controller for the position controlled flight 
mode, described by control expressions for the thrust mag- 
nitude and the moment vector, are: 

/ = {kxCx + kyBy + mge3 ~ mxd) ■ Re3, (19) 
M = -kuCR - fcaeo + x Jfi 



— Ji^ClR^ Rq^Iq — R^ R(Slc 



(20) 



where k^, ky, kjf , k^ are positive constants. Following the 
prior definition of the attitude error and the angular velocity 
error 



1 



CR^ -iR'.R-R'RcV, en^n-R'RA, (21) 

and the computed attitude Rc{t) E S0(3) and computed 
angular velocity flc E M.'^ are given by 

-Rc = [61,; 63. X 6ij 53J, Clc^R^R,, (22) 
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Fig. 2. Controller structure for position controlled flight mode 

where b^^ E is defined by 



W-kxCx - kyCy - mges + mxd\\ 



(23) 



and bic E is selected to be orthogonal to 63c, thereby 
guaranteeing that Rc E SO (3). We assume that 



-kxCx - kyCy - mges + mxd\\ ^ 0, 



(24) 



and the commanded acceleration is uniformly bounded such 
that 



— mges + mxd\\ < B 



(25) 



for a given positive constant B. 

The thrust magnitude controller and the moment vec- 
tor controller is feedback dependent on the position and 
translational velocity and they depend on the commanded 
position, translational velocity and translational acceleration. 
The control moment vector has a form that is similar to that 
for the attitude controlled flight mode. However, the attitude 
error and angular velocity error are defined with respect to a 
computed attitude, angular velocity and angular acceleration, 
that are constructed according to the indicated procedure. 

The nonlinear controller given by equations ( [T9] l, (20 1 
can be given a backstepping interpretation. The computed 
attitude Rc given in equation ( [22] i is selected so that the 
thrust axis —63 of the quadrotor UAV tracks the computed 
direction given by —63^ in (23 1, which is a direction of the 



thrust vector that achieves position tracking. The moment 



expression (20i causes the attitude of the quadrotor UAV to 
asymptotically track Rc and the thrust magnitude expression 



(19 1 achieves asymptotic position tracking. 

The closed loop system for this position controlled flight 
mode is illustrated in Figure |2] The corresponding closed 
loop control system is described by equations pi, (|3]l, (|4]l, 
(j5]l, using the controller expressions (19i and ( [20| . 

We now state the result that (e^;, e^,, e^, en) = (0, 0, 0, 0) 
is an exponentially stable equilibrium of the closed loop 
dynamics. 

Proposition 3: (Exponential Stability of Position Con- 
trolled Flight Mode) Consider the thrust magnitude / and 



moment vector M defined by equations (19 1, (20i. Suppose 
that the initial conditions satisfy 



vi/(i?(0),i?c(0)) < 1, 

l|e.(0)li <e,._, 



(26) 
(27) 



for a fixed constant e^^^^^^^. Define Wi,Wi2,W2 E 
be 



p2x2 



to 



Wi = 
W12 = 
W2 = 



-s^{l + a) fc,(l-a)-ci 



£1B 
m 

B -\- kxCx 

c^kR 
\m{J) 
__£2kn_ 
2A„(J) 





2A„(J) 

kn - C2 



(28) 
(29) 

(30) 



where «'(i?(0), i?c(0)) < V'l < 1, and a = V'^i(2- Vi). 
For positive constants kx,ky, we choose positive constants 
ci, C2, fcfl, fcn such that 



c, < mm ikyil- a), ^2(1 + „)2 + 4^fc^(i _ ' Vk. 



m 
(31) 



C2 < mm <^ kn, , 2 x fn^AU \ ^n2 'V«fl-^m J) 



XmiW2) > 



M\Wi2f 



(32) 
(33) 



Then, the zero equilibrium of the closed loop tracking errors 
{ex,ey,eji,en) = (0,0,0,0) is exponentially stable. A 



region of attraction is characterized by ( 26 1, ( 27 1, and 



|eo(0)||' < - *(i?(0), i?c(0))), (34) 



Xm{J) 

AAf(A/i2)||zi(0)|p + AM(Af^2)ll^2(0)|P < ^kxel^ 



(35) 



where zi = [lie, II, ||e„||F, - [||ei^||, ||en|lF G 



and 



M12 = ^ 



kx 

Cl 



Cl 
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Proof: See Appendix |D| ■ 
Proposition [3] requires that the initial attitude error is less 
than 90° to achieve exponential stability for this flight mode. 
Suppose that this is not satisfied, i.e. 1 < {R{Q) , Rc{Q)) < 
2. We can apply Proposition [T] which states that the attitude 
error function exponentially decreases, and therefore, it 
enters the region of attraction of Proposition [3] in a finite 
time. Therefore, by combining the results of Proposition [T] 
and [3] we can show almost global exponential attractiveness 
when *(i?(0),i?c(0)) < 2. 

Definition 1: (Exponential Attractiveness [21]) An equi- 
librium point z = of a dynamic systems is exponentially 
attractive if, for some S > 0, there exists a constant a{5) > 
and /3 > such that |jz(0)|| < S implies \\z{t)\\ < a{6)e-^^ 
for ah t > 0. 

This should be distinguished from the stronger notion of 
exponential stability, in which the above bound is replaced 
by ||z(t)|| <a(5)||z(0)||e-^*. 

Proposition 4: (Almost Global Exponential Attractiveness 
of the Position Controlled Flight Mode) Consider the thrust 



magnitude / and moment vector M defined in expressions 



(19 1, (20 1. Suppose that the initial conditions satisfy 



\\enm? < 



l<*(i?(0),i?c(0))<2, 



Aa/(J) 



(36) 
(37) 



Then, the zero equilibrium of the closed loop tracking errors 
{cx, By, en, en) — (0,0,0,0) is exponentially attractive. 

Proof: See Appendix |E] ■ 
In Proposition |4] exponential attractiveness is guaranteed 
for almost all initial attitude errors. Since the attitudes that 
lie outside of the region of attraction comprise a two- 
dimensional manifold in the three-dimensional S0(3), as dis- 



cussed in Section IV we claim that the presented controller 
exhibits almost global properties in S0(3). 

As described above, the construction of the orthogonal 
matrix Rc involves having its third column b^^ specified by 
a normalized feedback function, and its first column bi is 
chosen to be orthogonal to the third column. The unit vector 
bi^ can be arbitrarily chosen in the plane normal to 63^, 
which corresponds to a one-dimensional degree of choice. 
This reflects the fact that the quadrotor UAV has four control 
inputs that are used to track a three-dimensional position 
command. 

By choosing bi^ properly, we constrain the asymptotic 
direction of the first body-fixed axis. Here, we propose to 
specify the projection of the first body-fixed axis onto the 
plane normal to 63^. In particular, we choose a desired 
direction bi^ e S^, that is not parallel to 63^, and bi^ 
is selected as bi^ = Proj[6i^], where Proj[-] denotes the 
normalized projection onto the plane perpendicular to 63^. 
In this case, the first body-fixed axis does not converge to 
61^, but it converges to the projection of bi^, i.e. bi — >■ 61^ = 
Proj[&i^] as t —i' 00. In other words, the first body-fixed axis 
converges to the intersection of the plane normal to 63^ and 
the plane spanned by 63^ and bi^ (see Figure [3]l. From (23i, 
we observe that 63^ asymptotically converges to the direction 
.963 — Xd- In short, the additional input is used to guarantee 
that the first body-fixed axis asymptotically lies in the plane 
spanned by 61^ and ge^ — id- 

Suppose that Xd — 0, then the third body-fixed axis 
converges to the gravity direction 63. In this case, we can 
choose bi^ arbitrarily in the horizontal plane, and it follows 
that bi^ — > Proj[6i^] = bi^ as t — > cx). Therefore, the first 
body-fixed axis bi asymptotically converges to bi^, which 
can be used to specify the heading direction of the quadrotor 
UAV in the horizontal plane. 

Proposition 5: (Almost Global Exponential Attractiveness 
of Position Controlled Flight Mode with Specified Asymp- 
totic Direction of First Body-Fixed Axis) Consider the mo- 



ment vector M defined in (20i and the thrust magnitude / 
defined in (19 1 satisfying the assumptions of Propositions [3] 
andgl 

In addition, the first column of Rc, namely bi^ is con- 
structed as follows. We choose bi^{t) G S^, and we assume 
that it is not parallel to 63^ . The unit vector bi^ is constructed 



Plane 
normal to bs^ 



Plane spanned by 

— 'hi^ and 63^ 

Proj[6iJ 




Fig . 3. Convergence property of the first body-fixed axis: 63^ is determined 
by j23| . We choose an arbitrary fei^ that is not parallel to 63^, and project 
it on to the plane normal to 63^ to obtain b\^. This guarantees that the first 
body-fixed axis asymptotically lies in the plane spanned by bi^ and 63^, 
which converges to the direction of ge^ — as t — > 00. 

by projecting bi^ onto the plane normal to 63^, and normal- 
izing it: 

1 



-(63^ X (63^ X 61 J). 



(38) 



11^3. X5ij| 

Then, the conclusions of Propositions [3] and |4] hold, and the 
first body-fixed axis asymptotically lies in the plane spanned 
by 61^ and 563 - xa- 

In the special case where Xd ~ 0, we can choose 
in the horizontal plane. Then, the first body-fixed axis 
asymptotically converges to 61^. 

Expressions for Q.c and tic that appear in Proposition [s] are 
summarized in [22]. These additional properties of the closed 
loop can be interpreted as characterizing the asymptotic 
direction of the first body-fixed axis and the asymptotic 
direction of the third body-fixed axis as it depends on the 
commanded vehicle acceleration. These physical properties 
may be of importance in some flight maneuvers. 

VI. VELOCITY CONTROLLED FLIGHT MODE 

We now introduce a nonlinear controller for the velocity 
controlled flight mode. An arbitrary velocity tracking com- 
mand t — > Vd{t) G M'^ is given. The velocity tracking error 
is given by: 



V - Vd- 



(39) 



The nonlinear controller for the velocity controlled flight 
mode is given by 

f ^ {kyey +mge3-mvd) ■ Re3, (40) 
M = —kjieB. — knen + ft x JV, 

- JinR^Rc^c- R^Rctlc), (41) 

where ky,kii,kn are positive constants, and following the 
prior definition of the attitude error and the angular velocity 
error 

1 



eR^ ^{nin~ W UcY , en^n-R^RcVLc, (42) 
and Rc{t) E SO (3) and flc G R^ are constructed as: 

i?c - X 6ij 63J, nc = RlRc, (43) 

where 63^ G is defined by 

-kyBv — mge^ + mid 



b3a = -1 



ki, 



mges + mvd\\ 



(44) 



and bic E is selected to be orthogonal to 63c, thereby 
guaranteeing that Rc G SO (3). We assume that 



-k^Cv — mges + mxdW ^ 0, 
II — 771363 + mxd\\ < B 



(45) 
(46) 



for a given positive constant B. 

The overall controller structure and the corresponding 
stability properties are similar to the position controlled flight 
mode. More explicitly, the closed loop dynamics have the 
property that (e^,efl, eo) = (0,0,0) is an equilibrium that 
is exponentially stable for any initial condition satisfying 
'i' {R{0) , Rc{0)) < 1, and it is exponentially attractive for 
any initial condition satisfying ^'(i?(0), i?c(0)) < 2. Due to 
page limitations, the explicit statements of propositions and 
proofs for the velocity controlled flight mode are relegated 
to [22]. 

VII. NUMERICAL RESULTS ILLUSTRATING 
COMPLEX FLIGHT MANEUVERS 

Numerical results are presented to demonstrate the prior 
approach for performing complex flight maneuvers for a 
typical quadrotor UAV. The parameters are chosen to match 
a quadrotor UAV described in [23]. 

J = [0.0820, 0.0845, 0.1377] kg -m^, m = 4.34kg 
d = 0.315 m, c^/ = 8.004 X 10"^ m. 

The controller parameters are chosen as follows: 

kx — 16m, ky — 5.6m, kj^ = 8.81, fcji = 2.54. 

We consider two complex flight maneuvers. The first case 
corresponds to the position controlled mode; the results 
in Proposition |4] are referenced. The second case involves 
transitions between all of the three flight modes. 

Case (I): Position Controlled Flight Mode: Consider 
a hovering maneuver for which the quadrotor UAV recov- 
ers from being initially upside down. The desired tracking 
commands are as follows. 

Xd(t) = [0,0,0], &i,(t) = [1,0,0]. 

and it is desired to maintain the quadrotor UAV at a constant 
altitude. Initial conditions are chosen as 

a;(0) [0,0,0], t;(0) = [0, 0, 0], 

"10 " 

i?(0) = -0.9995 -0.0314 , f7(0) = [0, 0, 0]. 
0.0314 -O.9995J 

This initial condition corresponds to an upside down quadro- 
tor UAV. 

The preferred direction of the total thrust vector in the con- 
trolled system is —63. But initially, it is given by —63(0) — 
-i?(0)e3 = [0,0.0314,0.9995], which is almost opposite to 
the thrust direction [0, 0, —1] required for the given hovering 
command. This yields a large initial attitude error, namely 
178° in terms of the rotation angle about the eigen-axis 
between Rc{0) and i?(0), and the corresponding the initial 
attitude error is \I'(0) = 1.995. 



2 3 4 5 6 



2 3 4 5 6 



3 4 5 6 



2 3 4 5 6 



(a) Attitude error function 'J' (b) Position (xisolid, x^.doUed, (m)) 



(c) Angular velocity (rad/sec) 



(d) Thrust of each rotor (N) 



Fig. 4. Case I: position controlled flight mode for a hovering, recoveiing 
from an initially upside down attitude 



Therefore, we cannot apply Proposition [3] that gives ex- 
ponential stability when '5(0) < 1, but by Proposition |4j we 
can guarantee exponential attractiveness. From Proposition 
[T] the attitude error function ^ decreases; it eventually 
becomes less than 1 at f = 0.88 seconds as illustrated in 



Figure 4(a) At that instant, the attitude error enters the 
region of attraction specified in Proposition |3] Therefore, 
for t > 0.88 seconds, the position tracking error converges 



to zero exponentially as shown in Figures 4(b) The region 
of attraction of the proposed control system almost covers 
S0(3), so that the controlled quadrotor UAV can recover 
from being initially upside down. 

Case (II): Transition Between Several Flight Modes: 
This flight maneuver consists of a sequence of five flight 
modes, including a rotation by 720° (see Figure |5]). 

(a) Velocity controUed flight mode (t £ [0,4)) 

Vd{t) = [l + 0.5t, 0.2sin(27ri), -0.1], 
= [1,0,0]. 

(b) Attitude controlled flight mode (t e [4,6)): rotation 
about the second body-fixed axis by 720° 

Rd{t) = exp(27r(t-4)e2). 

(c) Position controlled flight mode (t e [6, 8)) 

Xd{t) = [U-t, 0, 0], bi,{t) = [1,0,0]. 

(d) Attitude controlled flight mode (t e [8,9)): rotation 
about the first body-fixed axis by 360° 

Rd{t) = exp(27r(< - 8)ei). 

(e) Position controUed flight mode (t £ [9, 12]) 

Xd(i) = [20-|t, 0, 0], 6i,(t) = [0,1,0]. 



(a) velocity tracking 




initial/terminal 
position 



Fig. 5. Case II: complex maneuver of a quadrotor UAV involving a rotation by 720° about £2 (b), and a rotation by 360° about ei (d), with transitions 
between several flight modes. The direction of the first body-fixed axis is specified for velocity/position tracking modes ((a),(c),(e)) (an animation illustrating 
this maneuver is available at http://my.fit.edu/~taeyoung I. 



Initial conditions are same as the first case. 

The second case involves transitions between several flight 
modes. It begins with a velocity controlled flight mode. As 
the initial attitude error function is less than 1, the velocity 
tracking error exponentially converges as shown at Figure 



6(d) and the first body-fixed axis asymptotically lies in the 
plane spanned by bi^ = ei and 1763 — Vd- Since \\vd\\ ^ g, 
the first body-fixed axis remains close to the plane composed 



of ei and 63, as illustrated in Figure 6(e) 



This is followed by an attitude tracking mode to rotate 
the quadrotor by 720° about the second body-fixed axis 
according to Proposition [T] As discussed in Section IV 
the thrust magnitude / can be arbitrarily chosen in an 
attitude controlled flight mode. We cannot apply the results 
of Proposition |2] for altitude tracking, since the third body- 
fixed axis becomes horizontal several times during the given 
attitude maneuver. Here we choose the thrust magnitude 
given by 

f{t) ^ {kxix{t) - Xc) + kvv{t) + mges) ■ R{t)e3, 

which is equivalent to the thrust magnitude for the position 

when Xd{t) — Xc = 



19 1, 



controlled flight mode given in 
[8,0,0]. This does not guarantee asymptotic convergence of 
the quadrotor UAV position to [8, 0, 0] since the direction of 
the total thrust is determined by the given attitude command. 
But, it has the effects that the position of the quadrotor UAV 
stays close to illustrated at Figure |6(b)| 

Next, a position tracking mode is again engaged, and the 
quadrotor UAV soon follows a straight line. Another attitude 
tracking mode and a position tracking mode are repeated 
to rotate the quadrotor by 360° about the direction of the 
second body-fixed axis. The thrust magnitude is chosen as 

fit) {K{x{t) - Xc) + Kv{t) + mgez) ■ R{t)ei, 

where Xc — [6,0,0], to make the position of the quadrotor 
UAV remain close to Xc during this attitude maneuver, as 
discussed above. For the position tracking modes (c) and 
(e), we have Xd ~ 0, and hi^ lies in the horizontal plane. 
Therefore, according to Proposition [5] the first body-fixed hi 
asymptotically converges to bi^, as shown at Figure 6(e) For 



example, during the last position tracking mode (e), the first 
body-fixed axis points to the left of the flight path since bi^ is 
specified to be 62. These illustrate that by switching between 
an attitude mode and a position and heading flight mode, 
the quadrotor UAV can perform the prescribed complex 
acrobatic maneuver. 

VIII. CONCLUSIONS 

We presented a global dynamic model for a quadrotor 
UAV, and we developed tracking controllers for three differ- 
ent flight modes; these were developed in terms of the special 
Euclidean group that is intrinsic and coordinate-free, thereby 
avoiding the singularities of Euler angles and the ambiguities 
of quaternions in representing attitude. Using the proposed 
geometric based controllers for the three flight modes we 
studied, the quadrotor exhibits exponential stability when the 
initial attitude error is less than 90°, and it yields almost 
global exponentially attractiveness when the initial attitude 
error is less than 180°. By switching between different 
controllers for these flight modes, we have demonstrated 
that the quadrotor UAV can perform complex acrobatic 
maneuvers. Several different complex flight maneuvers were 
demonstrated in the numerical examples. 

Appendix 
A. Properties of the Hat Map 
The hat map " : M"^ — > so (3) is defined as 





-X2 
)3 



-X'i 



Xl 



X2 
-Xl 





(47) 



for X — [xi]X2]X3] e M . This identifies the Lie algebra 
so(3) with using the vector cross product in M'^. The 
inverse of the hat map is referred to as the vee map, 
V : so(3) — >■ K'^. Several properties of the hat map are 
summarized as follows. 



xy ^ X X y = —y x x = —yx, 



(48) 
(49) 




(a) Attitude error function 'J' (b) Position (zisolid, x^jidotted, (m)) 



(c) Angular velocity (Hisolid, (d) Velocity (tiisolid, i)jj:dotted, 
f!ij:dotted, (rad/sec)) (m/s)) 



(e) First body-fixed axis (fei: solid, 
bi^ : dotted) 

Fig. 6. Case II: transitions between several flight modes for a complex 
maneuver 



tr[xA] = tr[Ax] = -tT[x{A - A^)] 



xA + A'^x^{{u\A]h^3-A}xY 



RxR^ 



(50) 
(51) 
(52) 



for any x,y eR^, Ae R^""^, and R e S0(3). 



B. Proof of Proposition [7] 

We first find the error dynamics for e^, eji, and define 
a Lyapunov function. Then, we show that under the given 
conditions, R{t) always lies in the sublevel set L2, which 
guarantees the positive-definiteness of the attitude error 
function ^I*. From this, we show exponential stability of the 
attitude error dynamics. 

a) Attitude Error Dynamics: We find the error dynam- 
ics for 'i>,eR,ea as follows. Using the attitude kinematics 
equations, namely R = RCi, 7?^ = RdP-d, ™d equation (52i, 
the time derivative of is given by 



Rd) 



1 

-tr 

2 

1 



— CldRd R + R^R^ 
R-dR-i^ ^ R^ Rd^dR^R) 



By (|9]l, ([50|, this can be written as 



1 



Rd) = ^el{RlR - R^RdY = • en- (53) 



Using equations (10 1 and (51 1, the time derivative of cr 
can be written as 



eR^]^[RlRen + enR^Rdy 

= ]^{tr[R^Rd] I - R^Rd)en = C(i?Ji?)en. 



(54) 



Now we show that \\C{R^R)\\2 < 1 for any R^ R (E 
S0(3). Using Rodrigues' formula [13], we can show that the 
eigenvalues of C"^(expa;)C(expi;) are given by cos^ ||a;||, 
^(1 + cos ||a;||), and 5(1 + cos ||a;||), which are less than or 
equal to 1 for any x G M.^. Therefore, \\C{R^R)\\2 < 1, and 
this implies that 

UrW < \\en\\ . (55) 
From equation (j9]), the time derivative of efj is given by 

Jen = Jn + JiClR^Rd^d ~ R^Rd^d), 

where we use a property of the hat map, xx = for any 
x e M.^. Substituting the equation of motion ^ and the 



(56) 



control moment ( [201 ), this reduces to 



In short, the attitude error dynamics are given by equations 
( [53] l, (|54]i, (|56]l, and they satisfy ( [55] l. 

b) Lyapunov Candidate: For a non-negative constant 
C2, let a Lyapunov candidate V2 be 

V2 = ^en • Jen + Ur Rd) + Cae^ • en- (57) 



From equations (53 1, ( |54] i, ( |56| ), the time derivative of V2 is 
given by 

V2 = eo • Jeo + kReR ■ en + C2eR ■ en + C2e_R • en 
= -kn\\en\\^ - C2kReR ■ J'^eR + C2C{R^R)en ■ en 
- c2kneR ■ J~^en- (58) 

Since \\C'{RJR)\\ < 1, this is bounded by 

V2 <-Z^W2Z2, (59) 

where Z2 = [||e_R|l, ||en||]^, and the matrix W2 G M^^^ is 
given by 



1^2 



C2kE 

Xm{J) 
__C2kn_ 
2A™(J) 



C2kn 
2A„(J) 

kn - C2 



c) Boundedness of "^: Define V2 
( |57l i, ( |58| l, we have 

1 



V2 



C2=0' 



(60) 
From 



^ = ^en- Jen + kR^{R,Rd), 
V2 = -kn\\en\? <Q. 



This implies that is non-increasing, i.e., V2{t) < V2(0). 
Using (13 I, the initial value of V2 is bounded by V2(0) < 



(61) 



2kji. Therefore, we obtain 

kR^{R{t),Rd{t)) < V!,{t) < V^(0) < 2kR. 
Therefore, the attitude error function is bounded by 

*(i?(t), < ^^2 < 2, for any t > 0, (62) 

and for tp2 — ^V2(0). Therefore, R{t) always lies in the 
sublevel set L2 = {R e S0(3) | Rd) < 2}. 

d) Exponential Stability: Now, we show exponential 
stability of the attitude dynamics by considering the general 
case where the constant C2 is positive. Using Rodrigues' 
formula, we can show that 



*(i?,i?<j) = 1 - COS ||a;|| , 



sm \ x\ 



(l + cos||a;||)^'(i?,i?rf) 



{2-^{R,Ra))^{R,Ra), 



(63) 



(64) 



when R^R = expx for x G M-^. Therefore, from (62i, the 
attitude error function satisfies 



IWeiif <^iR,Rd)< 



1 



2-^2 



(65) 



This implies that 4* is positive-definite and decrescent. It 
follows that the Lyapunov function V2 is bounded as 



zJM2iZ2 < V2 < Z^M22Z2, 



(66) 



where 

M21 



kR -C2 
-C2 Am(J) 



Ah: 



2-02 

C2 



C2 

Am(J). 



(67) 



We choose the positive constant C2 such that 

iknkRXmiJ)^ 



C2 < min < fc| 



" kf,XM{J)+^kRXrn{jy 



which makes the matrix W2 in ( |59) l and the matrices 
Af2i,M22 in ([66]) positive-definite. Therefore, we obtain 



(68) 



Xm{M2l)\\z2f < V2 < AAf(Af22)|k2||', 



V2 < -A™(M/2)lk2|| 



Let ft 



Am (A'f22) 



Then, we have 



V2 < -/32V2. 



(69) 



(70) 



Therefore, the zero equilibrium of the attitude tracking error 
Br, eo is exponentially stable. Using ([65]l, this implies that 



(2 - V2)A„(M2i)* < X„,{M2i)\\eRf 

< A„,(M2i)||z2|P < V2{t) < V2(0)e-'5=*. 

Thus, the attitude error function ^ exponentially decreases. 



But, from (62i, it is also guaranteed that < 2. This yields 

CI- 



C. Proof of Proposition |2] 

The rotational dynamics Q, (|5]l are decoupled from the 
translational dynamics (|2|, As the control moment and 
assumptions are identical to Proposition [T] all of the conclu- 
sions of Proposition [T] hold. 

To show altitude tracking, we take the dot product of ([3]) 
with 63 to obtain 

mx-i = mg- fcs ■ Re^. 



Substituting (15i into this, we obtain the altitude error 



dynamics as follows: 



mx3^ 



It it clear that this second-order Unear system is exponentially 
stable for positive kx,ky. 

D. Proof of Proposition [i] 

We first derive the tracking error dynamics. Using a 
Lyapunov analysis, we show that the velocity tracking error 
is uniformly bounded, from which we establish exponential 
stability. 

a) Boundedness of cr: The assumptions of Proposition 
[3] namely (|26]), (j34ji imply satisfaction of the assumptions 
of Proposition [T] \12\, (13 1, replacing the notation Rd by 
Re- Therefore, the results of Proposition 1 can be directly 
applied throughout this proof From ( [34| , equation ( [6T] ) can 
be replaced by 

kR^{R{t),R,{t)) < V^(0) < kR^Pi. (71) 

Therefore, the attitude error function is bounded by 

< ijji < 1, for any t > 0. (72) 

This implies that for the attitude always lies in the sublevel 



set Li = {R e S0(3) < !}■ From ((63JI, the 

attitude error is less than 90°. Similar to ( |65| ), we can show 
that 



IWenf <^{R,Rc)< ^ 



2 " - ' ' - 2~tl}i 
We also define the following domain D 

D = {(e2,,e^,i?, en) G 



X X ii X I ||g^ 



(73) 



(74) 



for a fixed constant e^^^^,^^, restricting the magnitude of 
the position error The subsequent Lyapunov analysis is 
developed in this domain D. 

b) Translational Error Dynamics: The time derivative 
of the position error is Cx = ev The time-derivative of the 
velocity error is given by 



mxd = mges - fRes - mxd- 



(75) 



Consider the quantity e^R^Re^, which represents the cosine 



of the angle between 63 = Re^ and be 



RcBs. Since 



1 — ^'(i?, Rc) represents the cosine of the eigen-axis rotation 



angle between Rc and R, as discussed in ( 63 1, we have 1 > 

ejR'^Res > 1 - > 0. Therefore, the quantity 

1 



e'^B.TRea 



is well-defined. To rewrite the error dynamics of 



e„ in terms of the attitude error e^, we add and subtract 
e^K^Re ^c^3 right hand side of (75i to obtain 

/ 



me^ — mges — mxd 



RcBs — X, 



(76) 



where X e M"^ is defined by 



X = 



_l 



{{ejRjRe3)Re3 - R^e^). (77) 



Let A — —kxCx — kyCy — rnges + mxd- Then, from \\9\ , 
( |23] l, we have f = -A- Res and 63^ = RcCs = -A/ \\A\\, 
i.e. —A = \\A\\Rce3. By combining these, we obtain / — 
{\\A\\ RcCs) ■ Res. Therefore, the third term of the right hand 
side of (|76ll can be written as 



_/_ i\\A\\ R^es) ■ Res A ^ 

ejRTRes^^'' e^R^Res ' PI! 



k^e-u — mges + mxd- 



Substituting this into ( 76 1, the error dynamics of e„ can be 
written as 



mev 



kx^x kyCy X. 



(78) 



c) Lyapunov Candidate for Translation Dynamics: For 
a positive constant ci, let a Lyapunov candidate Vi be 



1. n ,2 1 



(79) 



2 " " 2 

The derivative of Vi along the solution of ( [78] l is given by 

Vi kxGx ' e^ Cy • { kxex kyCy -\- X^ cic^? • ey 

~t~ Cx ' { kxex k^ey -{^ X^ 
m 

/, \ II II 2 ^ikx II II 2 (^iky 

= -(fc„ - ci)||e„|| \\ex\\ ex ■ Cy 



X ■ \ —ex + e„| 



(80) 



We find a bound on X using (77 1 as follows. Since / 

WAWie'^R'^Res), we have 

||X|| < \\A\\\\{elR'^Res)Res~Rce3\\ 



< (kxWexW + ky\\ey\\ + B) \\{ei Ri Res)Res - Rce^l 

The last term ||(e|'i?^i?e3)i?e3 — i?ce3|| represents the sine 
of the angle between 63 — Re^ and bc^ = Rc^s, since 

(&3e • ^3)63 - &3e = ^3 X (&3 X 63 J. 



From (64 1, ||efl|| represents the sine of the eigen-axis 



rotation angle between Rc and R. Therefore, we have 
follows that 



\{e'^R'^Re3)Re3 - Rce^W < ||ei?||. From (|64|, (|72|), it 



||(eji?ji?e3)i?e3 -toll < ||efl|| = v/*(2 - *) 

< v/V'i(2-V'i) = a< 1- 

Therefore, X is bounded by 

ll^ll < (fcxlle.ll +fc.||e„|| +S)||e,^|| 

< (fcxlle.ll +fc.|le„|| (81) 



Substituting this into ( [80| ), 

Vi < -{ky - ci)\\ey\\^ - 



2 ^l^x II II 2 



Clky 



+ {kx\\ex\\ + ky\\ey\\ + B)\\eR\\ { — \\ex\\ + ||e„||| 
< -iky{l ~a)- c,)\\eyf - ^(1 _ a)||e,|p 



Clky 

m 

\\eR 



(l + a)||e:,||||e. 
ci 



II { 



-Bile, 



B||e,i 



3.11} . (82) 



In the above expression for Vi, there is a third-order error 
term, namely fcj^HeijH He^iH ||ei,||. It is possible to choose its 
upper bound as fca;a||e2:||||eu|| similar to other terms, but the 
corresponding stability analysis becomes complicated, and 
the initial attitude error should be reduced further Instead, 



we restrict our analysis to the domain D defined at ( 74 1, and 
an upper bound is chosen as fcxea;„,iix||eij||||ei,||. 

d) Lyapunov Candidate for the Complete System:: Let 
V = Vi + V2 be the Lyapunov candidate of the complete 
system. 



V = ^fc,;||e,;|p + ^m||e„|p + cie^ 



1 



en • Jen + kR^{R, Rd) + 026^ • en- 



(83) 



Using ( 73 I, the bound of the Lyapunov candidate V can be 
written as 

Miizi + 1/212:2 < V < M12Z1 + zJM^2^2, (84) 

where zi = [|je,||, ||e„||]^, za = [||efl||, |leo||]^ G M^, and 
the matrices A^n, M12, M21, M22 are given by 



Mil = 



1 



M21 = 



1 



^1 

kR -C2 
-C2 A„i(J) 



-ci 

TO 



M12 = 



1 



kx ci 

Ci TO 



M22 = 



1 



r 2fcji 



2-^1 

C2 



C2 
AAf(J) 



Using ( 59 1 and ( (82] i, the time-derivative of V is given by 

V < -^f W^l^l + zlWi2Z2 ~ zIW2Z2, (85) 

where Wi,Wi2,W2 € M^^^ are defined as follows: 



1^1 

W^12 
W2 



-^1^(1 + a) fc.(l-a) 



Cl 



B kxBx 

Am (J) 
C2kn 





2A„(J) 
fco - C2 



(86) 
(87) 

(88) 



2A„(J) 

e) Exponential Stability: Under the given conditions 



(31 1, (32 1 of the proposition, all of the matrices Mn, M12, 
Wi, M21, M22, W2, and the Lyapunov candidate V become 
positive-definite, and 

V < -XmiWi)\\zif + ||Tyi2||2|kl||||22|| - Xm{W2)\\z2\\^. 



The condition given by ( 33 1 guarantees that V becomes 
negative-definite. Therefore, the zero equilibrium of the 



tracking errors of the complete dynamics is exponentially 
stable. A (conservative) region of attraction is characterized 
by a sub-level set of V contained in the domain D, as written 
at ([35]l, as well as ([34| required for the boundedness of cr. 



E. Proof of Proposition |5] 

The given assumptions ( p6| ), ( [37| ) satisfy the assumption 
of Proposition [T[ from which the tracking error Z2 ~ 
I is guaranteed to exponentially decreases, and 

to enter the region of attraction of Proposition [3] given by 
( p6l l, ( |34l i, in a finite time t*. 

Therefore, if we show that the tracking error zi = 
[Ije^;!!, ||e^,||] is bounded in t £ [0,t*], then the tracking error 
z = [21,2:2] is uniformly bounded for any t > 0, and it 
exponentially decreases for t > t* . This yields exponential 
attractiveness. 

The boundedness of zi is shown as follows. The error 
dynamics or Cy can be written as 

mey = mges — fRe^ — mxd- 

Let V3 be a positive-definite function of 1 1 e^; 1 1 and 1 1 1 1 : 

V3 = ^||e.|P + ^m||e.|p. 



Then, we have ||ex|| < \/2V3, ||e^,|| < \J -^V^- The time- 
derivative of V3 is given by 

% = ex - e„ + e„ • (mgea - /iJea - mXd) 

< lle^^llllei,!! + ||e„||||m5e3 - mxd\\ + ||e^,||||i?e3|||/|. 

Using p5| ), ^T9\ , we obtain 

V3 < II \\B + ||e^||(fca;||e:E|| + fc„||e^,|| + B) 

= fc„||e,|p + (2B + (fc, + l)||e,||)||e„|| 



^ Suppose 
In this time 



< diV3 + d2VV3, 

where di=K^+ 2{k^ + 1)^, da = 2B 
that V3 > 1 for a time interval [ta,h] C [0,f 
interval, we have ^/Vs, < V3. Therefore, 



V3 < (di +rf2)V3 



V3(<) < V3(ta)e(''^+'*^'(*-*"^ 



Therefore, for any time interval in which V3 > 1, V3 is 
bounded. This implies that V3 is bounded for < t < t*. 



In summary, for any initial condition satisfying ([36]l,( 37 1, 
the tracking error converges to the region of attraction for 
exponential stability according to Proposition [3] and during 
that time period, tracking errors are bounded. Therefore, 
the zero equilibrium of the tracking error is exponentially 
attractive. 



[3] P. Castillo, R. Lozano, and A. Dzul, "Stabilization of a mini rotorcraft 
with four rotors," IEEE Control System Magazine, pp. 45-55 (2005). 

[4] S. Bouabdalla, P. Murrieri, and R. Siegward, "Towards autonomous 
indoor micro VTOL," Autonomous Robots, vol. 18, no. 2, pp. 171-183 
(2005). 

[5] E. Nice, "Design of a four rotor hovering vehicle," Master's thesis, 
Cornell University (2004). 

[6] J. Gillula, G. Hoffmann, H. Huang, M. Vitus, and C. Tomlin, "Ap- 
plications of hybrid reachability analysis to robotic aerial vehicles," 
The International Journal of Robotics Research, vol. 30, no. 3, pp. 
335-354 (2011). 

[7] N. Guenard, T. Hamel, and V. Moreau, "Dynamic modeling and 
intuitive control strategy for an X4-flyer," in Proceedings of the IEEE 
International Conference on Control and Application (2005). 

[8] S. Bouabdalla and R. Siegward, "Backstepping and sliding-mode 
techniques applied to an indoor micro quadrotor," in Proceedings of the 
IEEE International Conference on Robotics and Automation, (2005), 
pp. 2259-2264. 

[9] A. Tayebi and S. McGilvray, "Attitude stabilization of a VTOL 
quadrotor aircraft," IEEE Transactions on Control System Technology, 
vol. 14, no. 3, pp. 562-571 (2006). 
[10] C. Mayhew, R. Sanfelice, and A. Teel, "Robust global asymptotic 
attitude stabilization of a rigid body by quaternion-based hybrid feed- 
back," in Proceedings of IEEE Conference on Decision and Control, 

(2009) , pp. 2522-2527. 

[11] S. Bhat and D. Bernstein, "A topological obstruction to continuous 
global stabilization of rotational motion and the unwinding phe- 
nomenon," Systems and Control Letters, vol. 39, no. 1, pp. 66-73 
(2000). 

[12] V. Jurdjevic, Geometric Control Theory. Cambridge University 
(1997). 

[13] F. Bullo and A. Lewis, Geometric control of mechanical systems. 
Springer- Verlag (2005) 

[14] D. Maithripala, J. Berg, and W. Dayawansa, "Almost global tracking 
of simple mechanical systems on a general class of Lie groups," IEEE 
Transactions on Automatic Control, vol. 51, no. 1, pp. 216-225 (2006). 

[15] D. Cabecinhas, R. Cunha, and C. Silvestre, "Output-feedback control 
for almost global stabilization of fuUy-acuated rigid bodies," in Pro- 
ceedings of IEEE Conference on Decision and Control, pp. 3583-3588 
(2008). 

[16] N. Chaturvedi, N. H. McClamroch, and D. Bernstein, "Asymptotic 
smooth stabilization of the inverted 3-D pendulum," IEEE Transac- 
tions on Automatic Control, vol. 54, no. 6, pp. 1204-1215 (2009). 

[17] M. Oishi and C. Tomlin, "Switched nonlinear control of a VSTOL 
aircraft," in Proceedings of IEEE Conference on Decision and Control, 
(1999), pp. 2685-2690. 

[18] R. Ghosh and C. Tomlin, "Nonlinear inverse dynamic control for 
mode-based flight," in Proceedings of the AIAA Guidance, Navigation 
and Control Conference (2000). 

[19] M. Oishi and C. Tomlin, "Switching in nonlinear minimum phase sys- 
tems: Applications to a VSTOL aircraft," in Proceedings of American 
Control Conference (2002). 

[20] D. Koditschek, "Application of a new lyapunov function to global 
adaptive tracking," in Proceedings of the IEEE Conference on Decision 
and Control, (1998), pp. 63-68. 

[21] Z. Qu, Robust Control of Nonlinear Uncertain Systems. New York, 
NY, USA: John Wiley & Sons, Inc. (1998). 

[22] T. Lee, M. Leok, and N. McClamroch, "Control of complex 
maneuvers for a quadrotor UAV using geometric methods on SE(3)," 
arXiv, (2010). [Online]. Available: http://arxiv.org/abs/1003.2005v3 

[23] P. Pounds, R. Mahony, and P. Corke, "Modeling and control of a large 
quadrotor robot," Control Engineering Practice, vol. 18, pp. 691-699 

(2010) . 



References 

[1] M. Valenti, B. Bethke, G. Fiore, and J. How, "Indoor multi-vehicle 
flight testbed for fault detection, isolation, and recovery," in Pro- 
ceedings of the AIAA Guidance, Navigation and Control Conference 
(2006). 

[2] G. Hoffmann, H. Huang, S. Waslander, and C. Tomlin, "Quadrotor 
helicopter flight dynamics and control: Theory and experiment," in 
Proceedings of the AIAA Guidance, Navigation, and Control Confer- 
ence (2007). 



